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1.  Introduction 


The  motivation  for  this  study  is  to  enhance  the  lethality  of  the  infantry  squad  though  precision 
guidance  technologies  for  small-diameter  projectiles.  Assault  and  carbine  rifles,  grenade 
launchers,  and  machine  guns  have  been  the  backbone  of  the  infantry  for  many  years.  Application 
of  miniaturized  low-cost  sensors  and  actuators  to  projectiles  in  this  environment  features  the 
potential  to  revolutionize  squad-level  lethal  capability. 

Precision  guidance  implies  some  means  of  navigating  and  maneuvering  the  lethal  payload.  The 
global  positioning  system  (GPS)  (i,  2),  inertial  measurement  units  (d),  and  seekers  (4)  often 
navigate  munitions  to  the  target.  Course  correction  may  be  achieved  through  aerodynamic  (5)  or 
jet  (d)  control.  These  technologies  are  adversely  affected  by  constraints  for  squad-level  weapons. 
Volume  is  a  critical  concern  since  the  diameter  of  these  projectiles  ranges  from  5.56  to  40  mm. 
These  projectiles  are  launched  from  rifled  guns  that  produce  spin  rates  of  hundreds  to  thousands 
of  rotations  per  second.  The  nonlinear  dynamics  of  high-spin-rate  projectiles  complicates  the 
sensor  stimuli  and  stresses  the  actuator  bandwidth.  Precision  guidance  technologies  in  most 
squad-level  weapons  must  perform  quickly  because  the  time  of  flight  is  often  only  a  few 
seconds.  It  is  essential  that  these  technologies  be  low  cost  and  easy  to  use  for  proliferation  on  the 
battlefield. 

The  hypothesis  of  this  study  is  that  flight  control  algorithms  and  novel  system  concepts  using 
low-cost  sensor  and  actuator  components  can  effectively  guide  small-diameter  gyroscopically 
stabilized  projectiles.  Guidance  and  flight  control  techniques  for  large,  slowly  rolling  projectiles 
(i,  7-9)  exist  in  the  literature,  but  there  is  no  published  work  for  small,  fast-spinning  airframes. 
These  flight  bodies  exhibit  unique  characteristics  that  increase  the  difficulty  of  the  guidance 
problem.  A  simple  strap-down  detector  (4)  supplies  the  only  feedback  in  this  report.  Strap-down 
detectors,  as  opposed  to  gimbaled  systems,  are  rigidly  mounted  to  the  projectile.  The  maneuver 
mechanism  is  an  innovative  configuration  using  gun-hardened  commercial-off-the-shelf  motors 
to  rotate  miniature  wings  into  the  airstream  (10-13). 

This  report  introduces  the  guided  projectile  concept.  Flight  models  are  provided  for  subsequent 
implementation  in  simulation.  Some  representative  flight  behaviors,  which  complicate  the 
guidance  problem  and  preclude  traditional  solutions,  are  provided.  A  reference-following-based 
guidance  and  control  approach  is  outlined.  System  identification,  parameter  estimation,  stability, 
and  control  algorithms  are  presented.  Notional  ballistic  and  controlled  flight  simulation  results 
are  given  along  with  Monte  Carlo  system  simulations  that  demonstrated  the  efficacy  of  these 
techniques.  A  nomenclature  of  terms  and  calculations  is  provided  at  the  end  of  this  report. 
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2.  Concept 


The  guidance  and  control  of  the  present  work  applies  to  the  gamut  of  squad  weapons.  A 
rendering  of  the  projectile  with  the  maneuver  and  navigation  technologies  is  shown  in  figure  1.  A 
40-mm-diameter  projectile  is  used  throughout  this  report  as  an  illustrative  example.  The  40-mm 
grenade  system  features  a  subsonic  launch  and  a  projectile  spin  rate  of  approximately  60  Hz. 


Figure  1.  Spin-stabilized  projectile  with  navigation  and  maneuver  components. 

To  reduce  cost  and  ensure  survivability  during  gun  launch,  commercial  optic,  imager,  and 
supporting  electronic  components  are  packaged  in  a  strap-down  manner  at  the  nose.  Effective 
usage  of  wider  field-of-view  lenses  balanced  with  sufficient  control  authority  for  given  ballistic 
launch,  and  flight  uncertainties  ensure  that  once  the  designated  spot  is  detected  on  the  imager, 
the  lethal  payload  can  be  maneuvered  close  to  the  target.  Fuzing  and  warhead  are  contained  in 
the  central  portion  of  the  projectile  body. 

The  maneuver  mechanism  is  placed  at  the  aft  end  of  the  spin-stabilized  projectile  to  maximize 
control  authority  {14,  15).  The  maneuver  section  includes  power  conditioning  electronics, 
processor,  microelectromechanical  inertial  sensors,  battery,  and  the  actuator.  This  mechanism 
consists  of  a  rotary  motor  (red  in  figure  1)  linked  to  a  deflected  wing  (light  blue  in  figure  1).  As 
the  projectile  body  spins  over  one  revolution,  the  motor  rotates  the  wing  in  the  opposite  direction 
at  the  same  rate.  This  deploys  the  wing  into  the  airstream  for  a  portion  of  the  roll  cycle  to  create 
an  aerodynamic  asymmetry.  An  assortment  of  means  may  be  used  to  vary  the  control  effort  since 
the  wing  has  a  fixed  deflection  angle.  Control  commands  can  “fishtail”  the  flight,  a  clutch  can 
decouple  the  motor  and  wing,  the  wings  can  rotate  at  a  frequency  off  the  projectile  spin  rate,  or 
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multiple  motor-wing  assemblies  can  mix  the  relative  phasing  of  roll  angle  to  deploy  the  wings 
into  the  airstream.  For  the  purposes  of  this  study,  two  motor-wing  assemblies  were  packaged 
near  the  projectile  base  oriented  180°  apart  in  roll  angle.  See  Fresconi  et  al.  {10),  Fresconi  et  al. 
{11),  Gross  et  al.  {12),  and  Fresconi  et  al.  {13)  for  more  details. 

The  design  of  maneuvering  spin-stabilized  airframes  is  an  active  research  area.  Large  control 
authority  is  difficult  to  obtain  due  to  gun-launched  packaging  constraints  and  because  dynamic 
flight  instabilities  {16,  17)  often  arise.  Further  difficulties  result  in  the  present  investigation 
because  the  flight  is  subsonic  and  little  dynamic  pressure  is  available.  Other  maneuver 
mechanisms  available  in  the  literature  for  small-diameter  spin- stabilized  projectiles  use  flow 
{18-20)  or  jet  {21)  control  techniques. 


3.  Flight  Modeling 


To  study  the  flight  of  this  guided  projectile  concept,  models  of  the  aerodynamics,  flight 
mechanics,  actuator,  and  feedback  measurements  must  be  formulated  and  implemented  in 
simulation.  The  body-fixed  coordinate  system,  illustrated  in  figure  2,  defines  the  aerodynamic 
angles  and  forces  and  moments. 


B 


Figure  2.  Body-fixed  coordinate  system. 
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Aerodynamic  forces  and  moments  consist  of  rigid  (projectile  body)  and  moveable  (wing) 
surfaces. 

X  +X^ 

r  =  +  pM  (1) 

z  =  Z^  +Z^ 

L  =  +L^ 

M  =  (2) 

N  ^  +N^ 

Projectile  body  (rigid)  forces  include  axial  force,  normal  force,  and  side  (Magnus)  force. 

X^  ^  -qS[c^^(M)  + 

„  1  o  pD 

(3) 

pD' 

Z«  =  -qS  [Q„(M)a  +  ^^3  (M)a^  +  a)P  ^ 

Projectile  body  (rigid)  moments  include  roll  damping,  static  pitching,  pitch  damping,  and 
Magnus  components. 

D  pD] 

L*  =  ,5d[c,^(M)^ 

r  qD  pD^ 

M«  =  qS  [c^„(M)a  +  (M)a^  +  C^^(M)  ^  JM,  a)P  ^  (4) 

„  r  o  pDi 

=  qS  d)a|^ 

A  general  model  of  the  wing  aerodynamic  forces  and  moments  was  built.  Some  relevant  roll 
angles  are  defined  because  the  wing  aerodynamics  depend  on  these  states.  The  relative  roll  angle 
of  the  wing  follows: 

=  (pCi-(p  (5) 

The  amount  of  wing  exposed  to  the  airstream  is  tracked  through  a  stowed  roll  angle. 

0j  =  Oi  -  (pB^  (6) 

The  total  (aMj)  and  yaw  (Pm^)  angles  of  attack  of  the  wing  also  need  to  be  computed  to 
determine  the  wing  aerodynamics. 
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(8) 


=  asin 


The  local  velocity  at  each  wing  in  local  wing  coordinates  is  obtained  through  the  following 
expression. 

pMi  =  T^mX^CG/I  +  ^B/I  ^  ^CG^CPi')  (9) 


The  aerodynamic  coefficients  for  each  wing  are  calculated  using  polynomial  expansions.  The 
relationship  between  the  aerodynamics  and  the  amount  of  the  wing  exposed  to  the  airstream  is 
embedded  through  the  dependence  on  the  stowed  roll  angle. 


cf ‘  =  (M,  («•  +  cy,  («•  +  C? ,  (M. 

M  “  M  “  M 


M 


(10) 


“M 


“  M 


Equations  for  the  aerodynamic  forces  and  moments  of  each  wing  in  projectile  body  coordinates 
are  provided. 


TX^n 

pMi 

yMi 

V  0  J 

L^r 

pMi 

0 

-N^i. 

pMi 

(11) 


Aerodynamic  forces  and  moments  are  input  to  characterize  the  flight  mechanics.  The  equations 
of  motion  are  formulated  in  the  inertial  frame  while  the  body  frame  was  used  for  collection  of 
aerodynamic  data.  The  Earth  coordinate  system  (subscript  E)  and  the  body-fixed  coordinate 
system  (subscript  B)  are  related  by  the  Euler  angles  for  roll  (4>),  pitch  (0),  and  yaw  (i|;)  as  shown 
in  figure  3. 
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Figure  3.  Earth  and  body-fixed  coordinate  systems  and  Euler  angles. 


The  6-degrees-of- freedom  model  was  applied  to  analyze  the  flight  mechanics  (22).  Equations  for 
the  translational  and  rotational  kinematics  in  the  body-fixed  coordinate  system  are  given. 


X 

^(p^lp  ^(p^9^Tp  ^Cp^Tp 

-u- 

y 

= 

C9S1P  SfjjSgS^p  +  C^C^p  CfpSgC^p  + 

V 

z. 

—Sg  SfjjCg  CfpCg 

-w- 

0 

6 

= 

.0. 

S(pie 

^(p 

S(p/ Ce 


-p- 

q 


(^4>/ Ce 


LrJ 


(13) 


Applying  Newtonian  kinetics  to  a  projectile  in  free-flight  results  in  the  following  translational 
and  rotational  dynamics  expressions. 


ii' 

V 

w. 


1 

m 


\X  +  Xa] 
Y  +  Yo 

2  +  Zg. 


0 

r 


l-q 


— r 

q  ■ 

-u- 

0 

-p 

V 

P 

0  . 

-w- 

P 

L 

1 

0 

p- 

q 

=  /-i 

M 

-/-i 

r  0  — p 

/ 

q 

f. 

.N. 

—q  p  0  . 

r- 

(14) 


(15) 


The  aerodynamics  are  computed  as  shown  in  equations  14  and  15,  and  the  gravity  force  is  found 
by 

[Ac  Tg  ZgF^TJJO  0  g]^  (16) 
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The  flight  control  command  for  this  concept  is  the  desired  maneuver  direction  {(pcMo)-  To  isolate 
the  controlled  flight  performance  we  assume  that  the  actuator  responds  sufficiently  faster  than 
the  airframe  (0cmd  —  4>c)  so  that  actuator  dynamics  may  be  neglected.  Complementary  studies 
have  been  performed  (13)  to  ensure  that  desired  and  realized  commands  closely  match. 

A  simple  feedback  concept  is  proposed  to  minimize  cost.  A  strap-down  detector  provides  the 
location  of  the  target  in  the  image  plane.  Details  concerning  whether  these  data  arrive  from  a 
laser-designated  spot  detector  or  through  image -based  navigation  are  irrelevant  for  this  study. 
Models  representing  target  detection  based  on  the  flight  mechanics  are  derived.  The  relative 
position  of  the  target  assuming  that  the  detector  is  aligned  with  the  projectile  body  coordinates  is 
formulated. 


VpT  —  Tbe^^ot  ^op) 

The  roll  angle  present  in  the  transformation  matrix  yields  a  rapidly  changing  target  location  as 
seen  by  a  strap-down  detector  for  a  spin-stabilized  projectile. 


In  practice,  a  passive  detector  obtains  only  the  lateral  relative  positions  and  the  actual  distance  is 
scaled  based  on  the  lens  properties. 


fi 


fi  L^pt(3) 


fpT 


(2) 


(18) 


Roll  estimation  is  necessary  to  resolve  the  target  error  components  in  the  fixed-plane  (i.e., 
nonspinning)  coordinate  system.  Devices  such  as  magnetometers  have  been  demonstrated  to 
provide  roll  (23-26). 


cos  0  —  sin  01  rCy 

sin0  COS0  J  L^z- 


(19) 


These  nonlinear  flight  models  were  implemented  in  simulation.  Input  data  for  the  mass 
properties  were  obtained  from  solid  modeling  and  from  semi-empirical  aeroprediction,  wind 
tunnel,  and  computational  fluids  dynamics  analyses  for  the  aerodynamics  (11).  Some  sample 
flight  simulation  output  is  provided  to  illustrate  key  aspects  of  the  system. 


Gun  rifling  imparts  high  spin  to  projectiles  to  ensure  gyroscopic  stability.  Spin  stabilization  leads 
to  incredibly  accurate  ballistic  systems  but  complicates  the  flight  behaviors.  The  spinning  body 
motion  produces  Magnus  moments  (27)  that  often  result  in  bounded  dynamic  instabilities  that 
manifest  in  the  flight  as  a  coning  motion.  The  system  under  investigation  was  launched  with 
conditions  necessary  to  fly  to  a  ballistic  range  of  200  m.  The  angular  motion  over  the  entire  flight 
(with  no  initial  angular  body  rates)  is  shown  in  figure  4.  The  amplitude  of  the  coning  varies  over 
the  flight  but  is  usually  around  1°.  The  direction  of  the  coning  is  counter-clockwise  when  viewed 
from  behind  the  projectile.  Aeromechanics  theory  (22)  dictates  that  this  coning  occurs  at  a 
natural  frequency  of  about  2  Hz  for  this  projectile.  The  Magnus  moment  is  often  highly  nonlinear 
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with  angle  of  attack  (e.g.,  maneuvering  flight  alters  the  response)  and  can  feature  considerable 
round-to-round  variation  due  to  manufacturing  tolerances,  atmospheric  conditions,  etc.,  so  the 
data  in  figure  4  only  illustrates  the  concept. 


Figure  4.  Angular  motion  for  ballistic  flight. 

Another  important  result  shown  in  figure  4  is  the  bias  in  the  yaw  angle  of  attack  to  about  -1°. 
This  phenomenon,  known  as  yaw  of  repose  (22),  is  due  to  the  spinning  body  in  atmospheric 
flight  in  the  presence  of  gravity  and  yields  a  cross-range  drift.  This  drift  is  evident  in  figure  5  as 
the  trajectory  bends  over  1  m  in  the  cross-range  direction  over  200  m  of  downrange  travel.  The 
center-of-gravity  motion  of  the  projectile  also  weaves  back  and  forth,  or  swerves,  as  a  result  of 
the  coning  action. 
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Past  work  (16,  17)  has  proved  that  flight  instabilities  occur  for  spin-stabilized  projectiles 
maneuvering  perpendicular  to  the  gravity  field  when  the  control  effectiveness  is  sufficiently 
high.  The  potential  for  this  instability  exists  in  the  current  application.  Figure  6  demonstrates 
large  amplitude  angular  motion  (counterclockwise  direction  when  viewed  from  behind 
projectile)  typical  of  flight  instability.  These  results  were  obtained  by  increasing  the  aerodynamic 
force  and  moment  of  the  wing  by  a  factor  of  three  in  the  nonlinear  simulations.  The  implications 
of  this  instability  mechanism  are  that  while  it  is  difficult  to  maneuver  small-diameter  spin- 
stabilized  projectiles,  there  is  an  upper  limit  on  the  control  authority  that  is  not  very  high. 
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4.  Guidance  and  Flight  Control 


Line-of-sight  rate  and  closing  velocity  estimates  are  used  to  form  proportional  navigation 
commands  in  classical  guidance  schemes.  Accelerometers  and  gyroscopes  often  supply 
additional  necessary  feedback.  The  accelerometers  ensure  that  the  airframe  is  maneuvering  the 
center  of  gravity  to  intercept  the  target  and  the  gyroscopes  help  damp  unwanted  angular  motion. 
This  scheme  may  not  be  applied  to  the  current  situation  for  a  variety  of  reasons. 

Low-cost  measurement  devices  are  severely  stressed  in  the  spin- stabilized  environment.  For 
example,  accelerometers  suffer  from  errors  in  bias,  scale  factor,  misalignment,  and  misposition. 
Figure  7  shows  a  true  and  measured  component  of  lateral  acceleration  for  a  typical  maneuvering 
flight  of  the  concept  under  investigation  in  this  study.  In  practice,  the  device  cannot  be  placed 
exactly  on  the  spin  axis  due  to  manufacturing  tolerances  (especially  at  low  cost).  As  a  result, 
high  acceleration  from  the  fast-spinning  axis  bleeds  over  into  the  lateral  channels  and  may 
overwhelm  the  true  lateral  acceleration.  There  is  also  significant  high-frequency  content  in  the 
signal  at  the  spin  rate  (approximately  60  Hz)  as  shown  in  the  oscillations  for  the  zoomed-in 
portion  of  the  measured  acceleration. 
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Figure  7.  True  and  measured  lateral  accelerometer  signal  for  ballistic  flight. 

Similar  arguments  apply  to  gyroscope  measurements  in  this  environment.  Furthermore,  even  if 
quality  gyroscope  measurements  were  available,  the  aerodynamic  control  concept  does  not  lend 
itself  to  damping  the  body  angular  rate. 

This  study  proposes  to  use  a  detector  as  the  minimal  feedback  measurement.  In  the  strap-down 
detector  plane,  the  target  rotates  at  the  spin  rate  and  superposes  the  motion  due  to  the  trajectory 
arc  and  the  coning.  This  action,  along  with  a  time  of  flight  on  the  order  of  seconds,  precludes 
high-accuracy  estimation  of  line-of-sight  rate  from  a  low-cost  detector.  For  these  reasons,  this 
study  simply  uses  the  raw  detector  plane  data  transformed  by  the  roll  angle  as  given  in  equations 
18  and  19  for  feedback  purposes. 

The  basic  structure  shown  in  figure  8  can  be  applied  to  summarize  the  reduced-state  control 
techniques  proposed  in  this  report.  The  loop  in  figure  8  is  used  in  the  cross-range  and  downrange 
directions.  The  nonlinear  system  dynamics  formulated  in  the  flight  models  above  is  contained  in 
the  function  H.  The  measurements  are  the  detector  data,  y  —  \^y  ^zY  ■  The  error  signal  is 
formed  by  subtracting  a  reference  from  the  feedback.  The  reference  in  the  cross-range  direction 
is  zero  but  the  downrange  direction  is  nonzero  to  account  for  the  trajectory  arc.  The  control 
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consists  of  the  magnitude  and  direction  of  maneuver.  This  integrated  guidance  and  control 
approach  resembles  that  found  in  the  literature  for  missiles  (28-30)  in  that  enhanced 
performance  is  sought  through  minimal  feedback. 


u  = 


tan 


-(4  -  4) 


(20) 


Figure  8.  Basic  control  structure. 


If  a  zero  reference  were  used  in  the  downrange  direction,  the  projectile  would  unnecessarily 
spend  valuable  control  effort  trying  to  maneuver  toward  the  ground  due  to  the  trajectory  arc.  A 
reference  signal  representing  the  curvature  of  the  trajectory  that  can  be  estimated  preflight 
overcomes  the  problems  of  a  zero  reference.  Technologies  such  as  a  weapon  fire  control  system 
or  attitude  estimation  onboard  the  projectile  using  magnetometers  can  supply  an  approximate 
launch  angle.  The  muzzle  velocity,  mass  properties,  and  aerodynamics  are  relatively  fixed 
entities  that  enable  a  downrange  reference  to  be  formed  specific  to  that  particular  launch  angle. 
An  example  of  a  reference  signal  for  a  launch  angle  of  about  15°  is  presented  in  figure  9.  These 
data  may  be  used  as  a  function  of  time  of  flight  to  effectively  zero  the  target  location  on  the 
detector  in  the  downrange  direction. 


Figure  9.  Representative  downrange  reference  signal. 
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The  nonlinear  dynamics  for  this  problem  along  with  the  limitations  of  practical  measurements 
prohibits  the  classic  control  design  method  based  on  finding  a  linear  relationship  between  the 
control  input  and  feedback  output.  Rather,  data  obtained  from  nonlinear  simulations  were  used  to 
obtain  a  relationship  between  the  control  magnitude  and  detector  response.  In  this  approach,  it  is 
critical  that  the  theory  and  data  in  the  simulations  are  appropriate,  which  is  supported  in 
complementary  literature  (10-13). 

Nonlinear  simulations  were  conducted  wherein  open-loop  maneuvers  were  commanded  at 
different  magnitudes  and  directions  (i.e.,  to  cause  the  projectile  to  travel  left,  right,  up,  or  down). 
The  resulting  response  data  due  to  these  maneuvers  was  collected.  More  specifically,  the  relative 
position  (equation  21)  and  velocity  (equation  22)  of  the  projectile  with  respect  to  the  target  in 
velocity  vector  coordinates  were  tabulated. 


TpT  —  Typ(rQj  Tqp) 

(21) 

_  p  ^OP  X  rp/0  y 

PpiT-rp/T  \r^p\2 

(22) 

System  identification  and  parameter  estimation  was  used  on  this  nonlinear  simulation  data  to 
build  and  populate  a  model  to  use  linear  systems  theory  in  determining  the  gains.  To  isolate  the 
control  dynamics,  the  ballistic  response  was  subtracted  from  the  data  collected  during  the 
maneuvering  flights.  A  second-order  model  with  a  forcing  function  was  offered  to  capture  the 
essential  elements  of  the  system  dynamics  based  on  inspection  of  these  data. 

£  + (23) 

This  model  was  implemented  in  a  parameter  estimation  algorithm  to  obtain  data  necessary  for 
selecting  gains  based  on  linear  systems  theory.  A  maximum  likelihood  method  was  applied  to 
find  the  model  parameters  (31,  32).  This  nonlinear  technique  uses  measurements  to  seek  model 
parameters  that  minimize  a  cost  function.  The  states  for  this  problem  were  the  detector  error  rates 
and  errors,  x  =  Measurements  of  these  states  were  supplied  by  the  nonlinear  simulation 

as  described  and  predictions  of  these  states  were  based  on  propagating  the  model  in  equation  23 
forward  in  time.  The  control  was  the  input  multiplied  by  a  scaling.  The  value  of  [i  was  the 
fraction  of  the  baseline  control  effectiveness  used  in  the  nonlinear  flight  simulation  (0  <  /r  <  1). 
The  parameter  vector  was  formulated  given  these  models. 

0=  Oin  (24) 

An  example  of  this  analysis  is  shown  in  figure  10.  Four  levels  of  baseline  control  effectiveness 
(0.25,  0.50,  0.75,  and  1.00)  were  investigated  with  a  maneuver  to  extend  range.  The  circles 
represent  the  measurements  from  the  nonlinear  flight  simulation  and  the  curves  are  from  the 
parameter  estimation  with  the  surrogate  model.  Oscillations  in  the  nonlinear  response  due  to 
angular  motion  increase  with  control  effectiveness.  The  simplified  model  cannot  reproduce 
specific  aspects  of  the  highly  nonlinear  dynamics;  however,  the  essential  features  regarding  how 
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the  control  influences  the  detector  response  are  captured.  In  any  event,  this  surrogate  model  is 
used  to  aid  gain  selection  prior  to  control  performance  assessment  in  nonlinear  flight  simulations. 
Model  parameters  from  the  estimation  are  provided  in  table  1 . 


Table  1.  Parameter  estimation  data. 


U) 

iWn  (rad/s) 

/«(in/s^) 

2.5106 

0.26061 

3.6356 

Model  formulation  and  parameter  estimation  results  enable  control  design.  The  control  system 
dynamics  can  be  expressed  mathematically  with  the  previously  stated  definitions  of  the  state 
vector  and  control.  An  error  rate  gain  does  not  appear  in  equation  25  because  the  overarching 
reduced-state  feedback  approach  proposed  in  this  study  (and  shown  in  equation  20)  is  to  use 
simple  position  errors  in  the  detector  plane.  The  relationship  between  the  gain  in  the  surrogate 
model  and  the  control  law  used  in  the  nonlinear  flight  simulation  is  trivial  (K^  = 

1  0  J 
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Equipped  with  the  parameter  estimates  and  equation  25,  investigation  of  the  system  structure  was 
undertaken.  Figure  1 1  shows  the  eigenvalues  as  a  function  of  the  gain.  These  data  indicate  the 
system  is  always  stable.  As  the  gain  increases,  the  system  undergoes  a  change  from  critically 
damped  to  oscillatory  behavior.  The  manner  in  which  the  damping  ratio  decreases  as  the  gain 
increases  is  critically  important  for  this  application  since  damping  is  not  explicitly  used  in  the 
feedback.  This  analysis  was  used  to  select  initial  values  for  the  control  gain  used  in  the  nonlinear 
flight  simulation. 


Real 


Figure  11.  Eigenvalues  for  different  values  of  gain. 


The  goal  now  is  to  relate  gains  from  the  surrogate  model  used  for  parameter  estimation  and 
linear  analysis  (e.g.,  equation  26)  to  gains  in  the  nonlinear  controller  with  the  strap-down 
detector  (equations  18-20)  through  model  equivalency.  An  expression  for  the  rate  of  change  of 
the  detector  error  in  the  body  frame  is  given. 


_ 


fi 


VpT  + 


fl 


{rp/A^)  -  fi) 


(jplp  <^B/l  ^  Ppp) 


(26) 
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The  lens  properties  may  be  added  to  the  equations  for  the  position  and  velocity  in  the  velocity 
vector  coordinates  to  model  a  detector  mounted  in  the  velocity  vector  coordinates.  The  velocity 
vector-mounted  and  strap-down  (body-mounted)  detector  models  are  summarized  in  table  2. 
Comparing  these  detector  models  in  table  2  highlights  some  structural  similarities. 


Table  2.  Detector  models  for  position  and  velocity  of  target. 


Coordinates 

Position 

Velocity 

Velocity  vector 

e*'  \ 

fL-rkW 

Tiz  -‘1/ 

f  .  rpV 

JL  'pTy^J 

Body  fixed 

-‘R  -‘R 

Tr  fh  -^D 

^  f  rn  ^ 

JL 

For  model  equivalency  purposes,  assume  that  the  airframe  flies  at  low  total  angle  of  attack  so 
that  6^  ~  .  This  assumption  will  be  further  supported  with  an  observer  designed  to  remove 

excess  angular  motion. 


We  define  states  Xg  =  [e  eY  and  controls  Ug  —  —KgXg  with  a  component  of  the  detector 
error  e.  Assume  rp/7^(l)  =  V  and  —  Vt  since  the  forward  velocity  dominates  the  velocity 

vector  and  velocity  decay  is  small  over  these  flights.  The  following  relationships  are  defined 
between  the  velocity  vector-mounted  (i.e.,  surrogate)  model  in  equation  23  and  the  strap-down 
detector  model. 


fi  ,  fi  . 

p.  =  — = - P  H - =—  P 

-  kY  k  -  yt 


(27) 


e  = 


k 

k-vt^ 


(28) 


Similar  to  equation  23,  the  expressions  in  equations  27  and  28  apply  to  both  lateral  components 
[e.g.,  e'^(2),  e'^(3)].  Next,  equate  the  controls  of  the  two  models  by  setting  [j.  =  Ug  and 
manipulating  along  with  equations  27  and  28  to  yield  the  final  relationship  for  gains. 


Ke 


k-vtKg 

k  U 


(29) 
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This  expression  provides  a  means  to  analyze  the  control  system  using  surrogate  modeling  and 
then  apply  the  appropriate  scaling  to  the  full  nonlinear  controller.  The  nonlinear  control  gain 
features  a  linear  term  with  time  of  flight.  The  lens  properties,  flight  velocity,  and  surrogate  model 
control  scaling  also  influence  the  gain. 


An  observer  was  constructed  to  remove  excess  angular  motion  in  the  strap-down  detector 
attributable  to  nonlinear  spin- stabilized  flight  dynamics  (e.g.,  fast  and  slow  modes  or  angular 
motion,  yaw  of  repose).  The  measurement  model  follows. 


fy  -I-  f^sin^odst  -I-  75)  -I-  fpsin{(x}pt  -I-  yp)' 
fz  +  fpcos^ojst  +  75)  +  fpCOs(a)pt  -I-  Yp). 


(30) 


The  basic  premise  of  this  estimator  is  that  flight  dynamic  theory  (22)  may  be  applied  to 
determine  epicyclic  motion  (i.e.,  fast  and  slow  modes)  in  the  detector  and  the  remaining  signal  is 
attributable  to  the  error  in  heading  to  the  target.  The  fast  and  slow  mode  frequencies  and  phase 
shifting  for  right-hand  gun  rifling  can  be  predicted  a  priori.  This  leaves  the  following  states  for 
this  problem. 

x*  =  [f;  75  r;  7f  4T  (31) 


This  model  and  states  were  implemented  in  a  Kalman  filter  assuming  that  each  variable  in  the 
state  vector  is  constant  between  measurement  updates.  The  measurement  input  was  the  nonlinear 
detector  model  in  fixed-plane  coordinates  (equation  19)  with  the  downrange  reference  (f^) 
applied.  The  output  of  this  estimator  was  used  in  the  flight  controller  (equation  20). 


5.  Results 


These  guidance  and  control  techniques  were  implemented  in  the  nonlinear  flight  simulations  to 
assess  performance.  In  practice,  ballistic  delivery  of  a  lethal  payload  has  errors  due  to  effects 
such  as  muzzle  velocity  variation,  imperfect  targeting  and  aiming,  manufacturing  tolerances, 
fuzing,  and  atmospheric  disturbances.  When  adding  guidance  components,  errors  due  to 
corrupted  measurements  and  actuator  performance  must  be  considered.  Models  and  input  data  to 
account  for  these  error  sources  were  incorporated  along  with  Monte  Carlo  techniques  into  the 
flight  analysis  (11,  33) 

Simulations  were  conducted  using  this  reduced-state  guidance  approach.  Shown  in  figure  12  is  a 
representative  fixed-plane  output  of  the  target  motion  in  the  detector  plane  (applying  the 
reference  in  the  downrange  direction)  from  a  guided  flight  with  uncertainties  to  a  target  at 
200  m.  The  blue  curves  represent  the  cross-range  data  and  the  purple  curves  are  for  the 
downrange  direction.  The  raw  and  estimated  body  fixed  signals  are  given  along  with  the  velocity 
vector  signal.  The  downrange  reference  signal  has  been  applied  to  all  curves.  High-  and  low- 
frequency  content  is  evident  in  the  raw  body  fixed  data.  The  projectile  epicyclic  motion  adds 
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complexity  to  the  deteetor  signal,  whieh  may  lead  to  poor  guidanee  performanee.  Fortunately, 
the  dynamies  of  the  epicycle  are  included  in  the  estimator.  The  filtered  data  effectively  removes 
the  fast  and  slow  mode  motion  so  that  only  the  heading  error  remains.  The  deteetor  error  in 
veloeity  veetor  eoordinates  (top-left  equation  in  table  2)  is  provided  in  figure  12  as  a  baseline  for 
comparing  the  filtered  body  fixed  data.  While  impractieal,  the  detector  signal  in  velocity  vector 
coordinates  may  provide  optimal  feedbaek  for  this  problem.  There  is  eonsisteney  between  the 
filtered  body  fixed  and  veloeity  veetor  signals  but  agreement  is  not  perfeet. 


Aeeording  to  the  filtered  feedbaek  signals  in  figure  12,  the  projeetile  flies  with  relatively  low 
error  in  the  cross-range  direction.  The  downrange  error  grows  to  negative  values,  indieating  that 
perhaps  the  weapon  was  aimed  too  low  or  the  muzzle  veloeity  was  slower  than  expeeted. 
Regardless,  eontrol  eommands  to  maneuver  the  projeetile  away  from  the  ground  should  result 
from  this  feedback  signal.  Poor  control  commands  would  result  from  using  the  raw  body  fixed 
signal  since  the  magnitude  of  the  fast  and  slow  mode  oseillations  are  the  same  or  greater  than  the 
remaining  heading  error.  The  finite  error  magnitude  in  figure  12  at  the  end  of  the  flight 
underseores  the  difficulty  in  sufficiently  maneuvering  small-diameter  spin-stabilized  projectiles 
without  inducing  instability. 
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Control  commands  resulting  from  using  raw  body  fixed  signals  in  figure  12  for  feedback  is  given 
in  figure  13a.  The  blue  circles  representing  the  maneuver  direction  have  the  scale  on  the  left- 
hand  axis.  The  green  diamonds  represent  the  maneuver  magnitude  with  the  seale  on  the  right  side 
of  the  plot.  Cascading  of  the  angular  and  swerving  motion  of  the  projectile  through  the  feedback 
and  into  the  control  commands  is  evident  in  the  data  of  figure  13a.  The  commanded  maneuver 
direetion  oscillates  in  all  direetions  since  the  magnitude  of  the  signal  attributable  to  the  fast  and 
slow  mode  motion  is  equal  to  or  greater  than  the  actual  heading  error.  The  control  amplitude  also 
quickly  saturates  yielding  high  angle-of-attack  flight  dynamic  instabilities  as  described  for 
figure  6.  The  nonlinear  dynamics  inherent  to  this  class  of  flight  bodies  yields  feedback  responses 
on  the  same  order  as  the  control  action. 

The  subsequent  eontrol  commands  based  on  the  filtered  error  signals  shown  in  figure  12  is 
provided  in  figure  13b.  The  utility  of  feedback  that  includes  the  flight  dynamics  in  the  estimation 
algorithm  is  rapidly  apparent  when  contrasting  figures  13a  and  13b.  The  control  commands  in 
figure  13b  are  much  smoother.  Consistent  with  the  discussion  for  the  filtered  error  signal,  the 
algorithm  generally  commands  the  projectile  to  maneuver  up  to  compensate  for  the  launch  or 
flight  errors  (e.g.,  low  aim  angle,  low  muzzle  velocity).  The  magnitude  of  the  maneuver  remains 
around  0.25  over  the  flight  eventually  reaehing  saturation  shortly  before  impact. 


(a)  (b) 


Figure  13.  Representative  control  commands  for  guided  flight;  control  commands  resulting  from  using  raw 
body  fixed  signals  in  figure  12  (a)  and  control  commands  based  on  the  filtered  error  signals  in 
figure  12  (b). 

The  modeling,  parameter  estimation,  and  stability  analysis  for  control  design  was  critical  to 
successful  guidance  in  the  nonlinear  simulations.  The  control  gain  used  in  nonlinear  simulations 
was  one  that  is  consistent  with  the  values  obtained  in  the  linear  analysis  (figure  11).  The  adaptive 
gain  scheme  (i.e.,  linearly  increasing  with  time)  proposed  in  equation  29  provided  sufficient 
control  commands  while  still  keeping  the  angle  of  attack  sufficiently  small.  Dynamic  flight 
instabilities  such  as  that  illustrated  in  figure  6  were  encountered  when  higher  gains  were  used 
early  in  flight  for  simulations  conducted  without  the  adaptive  gain  scheme. 
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The  angular  motion  produced  by  the  control  commands  of  figure  13b  based  on  the  filtered 
feedback  in  figure  12  is  presented  in  figure  14.  Launch  disturbances  yield  angular  motion 
amplitude  around  2°  in  both  the  fast  and  slow  mode.  The  epicycle  damps  throughout  flight,  but 
the  Magnus  moment  for  this  flight  vehicle  excites  the  slow  mode.  The  “up”  guidance  commands 
through  a  majority  of  this  flight  result  in  a  slightly  positive  pitch  angle  of  attack.  The  yaw  angle 
of  attack  has  a  small  negative  value  mainly  due  to  yaw  of  repose.  Both  pitch  and  yaw  angles  of 
attack  increase  near  impact  since  the  maneuver  magnitude  saturates. 


Figure  14.  Angular  motion  history. 


The  trajectory  is  shown  in  figure  15.  The  center  of  gravity  reaches  almost  14  m  in  altitude  to  fly 
about  200  m  downrange  in  just  under  3.5  s.  This  representative  guided  flight  impacted  about  1  m 
from  target  in  contrast  to  the  same  flight  without  any  guidance,  which  landed  about  10  m  away. 
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Downrange  (m) 


Figure  15.  Trajectory. 

The  delivery  accuracy  increase  of  the  guided  flight  over  the  ballistic  flight,  especially  since  this 
is  a  proof  of  concept  and  the  system  is  not  optimized,  is  sufficient  to  enhance  target  effect  and 
merits  further  consideration.  Monte  Carlo  analysis  was  conducted  on  this  system  to  determine 
fuller  spectrum  guided  performance  with  respect  to  ballistic  performance.  The  ballistic  and 
guided  impact  locations  resulting  from  a  set  of  100  Monte  Carlo  replications  is  provided  in 
figure  16.  Guided  flights  were  conducted  using  three  different  feedback  sources:  raw  body  fixed, 
filtered  body  fixed,  and  velocity  vector. 
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Figure  16.  Impacts  from  Monte  Carlo  system  simulations  of  ballistic  and  guided  flight. 


Ballistic  impacts  are  spread  along  the  downrange  axis  due  to  the  launeh  angle  (15°)  and  physics 
of  the  deliver  error  proeess  (e.g.,  muzzle  velocity  variation).  The  guided  flight  tightens  the 
impaet  grouping.  As  expected,  the  filtered  body  fixed  feedback  enhances  performance  over  the 
raw  body  fixed  feedback  but  does  not  perform  as  well  as  using  the  deteetor  signal  in  veloeity 
vector  coordinates.  Spread  in  the  impact  distribution  does  remain  in  the  guided  flights  due  to  the 
diffieulties  diseussed  (e.g.,  eoning  and  swerve  motion,  praetieal  feedbaek  limitations,  and 
eonstraint  on  eontrol  authority  due  to  instability)  for  small-diameter  spin-stabilized  projeetiles. 

The  data  shown  in  figure  16  feature  many  impact  points  lying  on  top  of  each  other;  therefore, 
these  data  are  presented  in  a  slightly  different  manner  in  figure  17.  This  histogram  shows  how 
this  reduced-state  guidance  seheme  reduces  the  miss  distanee  from  the  ballistie  system.  The 
guided  eireular  error  probable  is  3. 1  m  using  deteetor  feedbaek  in  velocity  vector  coordinates, 

4.2  m  with  filtered  body  feedback,  and  5.4  m  with  raw  body  feedback.  The  corresponding 
ballistic  circular  error  probable  is  8.6  m.  These  data  support  the  hypothesis  that  guidance  and 
eontrol  algorithms  and  novel  eoncepts  using  low-cost  measurement  and  maneuver  eomponents 
can  be  used  to  effectively  guide  small-diameter  spin-stabilized  projectiles.  The  main  contributor 
to  guidance  error  is  the  nonlinear  dynamics  (e.g.,  eoning,  swerve)  of  the  projeetile  influeneing 
the  filtered  deteetor  feedbaek  and  the  subsequent  eontrol  input.  Schemes  to  mitigate  these  issues, 
such  as  additional  damping  or  improved  state  estimation,  would  improve  performanee. 


22 


14 


12 


0  5  10  15  20  25  30  35  40 

Miss  Distance  (m) 


Figure  17.  Histograms  of  impacts  from  Monte  Carlo  system  simulations  of  ballistic  and 
guided  flight. 


6.  Conclusions 


This  report  proposed  a  guidance  and  control  approach  incorporating  small  size  and  cost 
technologies  applicable  across  a  wide  variety  of  infantry  weapons.  This  effort  is  unique  in  the 
literature  by  considering  not  only  the  maneuverability  (12,  13, 18-21)  and  feedback 
measurements  for  small-diameter  gyroscopically  stabilized  projectiles,  but  also  the  overall 
guided  performance  using  a  novel  control  scheme. 

The  concept  was  sketched  and  shown  integrated  into  a  40-mm-diameter  projectile  package.  A 
low-cost  strap-down  detector  in  the  nose  supplies  feedback  measurements.  The  lethal  payload 
takes  up  the  midbody  and  the  maneuver  mechanism  is  at  the  rear.  The  maneuver  mechanism  is 
innovative  in  using  low-cost  rotary  motors  to  achieve  high  actuation  frequencies  necessary  for 
spin- stabilized  projectiles.  A  few  different  means  of  continuously  varying  the  maneuver 
magnitude  were  discussed. 
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Nonlinear  flight  models  of  the  aerodynamics,  flight  mechanics,  actuators,  and  measurements 
were  formulated  and  implemented  in  simulation  to  facilitate  guidance  and  control  design  and  test 
the  hypothesis  of  this  study.  Key  aspects  of  spin-stabilized  projectile  dynamics  relevant  to 
guidance,  including  short  time  of  flight,  coning,  swerve,  drift,  and  instability,  were  illustrated. 

The  classic  guidance  and  control  approach  was  summarized,  and  the  inadequacy  of  this  scheme 
for  the  current  investigation  was  demonstrated  through  nonlinear  simulation  of  corrupted 
accelerometer  measurements.  Unique  reduced-state  feedback  control  techniques  were 
introduced.  A  reference  signal  was  proposed  for  increasing  guidance  efficiency.  The 
measurement  and  actuation  components  required  to  implement  this  control  scheme  are  low  cost 
and  practical. 

Modeling  of  the  feedback-control  response  was  undertaken  to  accommodate  the  extreme 
nonlinearities  present  in  spin- stabilized  dynamics.  Parameter  estimation  routines  were  applied  to 
obtain  model  parameters  using  nonlinear  simulation  data.  Initial  control  design  was  performed 
using  these  models  and  parameters. 

The  guidance  and  control  was  investigated  in  nonlinear  simulation  that  incorporated  system 
uncertainties.  The  feedback  and  corresponding  control  commands  from  guided  flights 
demonstrated  the  approach.  Results  highlighted  the  difficulties  associated  with  guiding 
spin- stabilized  projectiles  such  as  using  practical  feedback  in  the  presence  of  coning  and  swerve 
motion,  and  balancing  control  authority  with  instability. 

Monte  Carlo  simulations  were  conducted  to  assess  lethal  payload  delivery  via  ballistic  and 
guided  means.  Delivery  accuracy  for  a  nonoptimized  guided  configuration  was  more  than  a 
factor  of  two  better  than  the  ballistic  delivery  suggesting  that  further  research  is  warranted. 
Overall,  this  study  supports  the  hypothesis  that  flight  control  algorithms  and  novel  system 
concepts  using  low-cost  sensor  and  actuator  components  can  be  used  to  effectively  guide  small- 
diameter  gyroscopically  stabilized  projectiles. 
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